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ABSTRACT 

This  paper  covers  the  design  of  a  dynamic  positioning  system  for  the  U.S.  Coast  (3uard 
WLB  "IRIS"  class  buoy  tender.  The  control  system  design  is  based  upon  optimal  con- 
trol theory  with  estimates  of  position  and  heading  provided  by  a  steady  state  Kalman 
filter.  Sea  current  estimates  are  provided  by  a  Kalman  filter  predictor  based  upon  the 
innovations  process.  The  vessel  and  dynamic  positioning  system  are  simulated  using  the 
Dynamic  Simulation  Language  (DSL). 


THESIS  DISCLAIMER 

'I  he  reader  is  cautioned  that  computer  programs  developed  in  this  research  may  not 
have  been  exercised  for  all  cases  of  interest.  While  every  effort  has  been  made,  within 
the  time  available,  to  ensure  that  the  programs  are  free  of  computational  and  logic  er- 
rors, they  cannot  be  considered  validated.  Any  application  of  these  programs  without 
additional  verification  is  at  the  risk  of  the  user. 
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I.     INTRODUCTION  TO  DYNAMIC  POSITIONING  SYSTEMS 

A.  DEFINITION 

A  dynamic  positioning  system  (DPS)  is  an  automatic  control  system  that  will  drive 
a  vessel  to  a  selected  position  and  maintain  that  position  and  selected  heading  using 
computer  control  of  propulsive  thrusters.  A  DPS  includes  one  or  more  position  and 
heading  measurement  systems  and  a  computer-directed  control  system.  The  system 
should  keep  the  vessel  within  its  specified  position  and  heading  constraints  with  optimal 
use  ofpropulsors.  reducing  the  wear  on  that  machinery. 

B.  ADVANTAGES  AND  DISADVANTAGES 

The  use  of  DPS  is  not  new.  The  first  dynamic  positioning  systems  appeared  in  the 
late  1960  s  on  coring,  cable  laying  and  surface-support  ships  for  underwater  work.  1  he 
success  of  these  initial  DP  vessels  spread  the  application  of  the  systems  into  oO'shore  oil 
industry,  dredging,  precision  dumping,  pipe  laying,  and  fioating  hotels. 

There  are  several  advantages  of  dynamic  positioning  over  anchor  deployment.  It  is 
usable  in  all  water  depths  and  not  constrained  by  the  length  of  its  anchor  chain.  In 
contrast  to  anchoring,  there  is  virtually  no  set-up  time  required  to  begin  stationkccping. 
In  order  to  reach  and  attain  a  precision  position  by  anchoring,  time  and  personnel  in- 
tensive anchoring  details  must  be  set.  A  DPS  allows  a  vessel  to  attain  virtually  any  po- 
sition and  heading  automatically.  Due  lo  its  dynamic  nature,  a  DPS  vessel  can  work  in 
close  quarters  with  fixed  platforms  or  anchored  vessels.  A  dynamic  positioning  system 
is  designed  to  operate  in  adverse  weather  conditions 

The  disadvantages  of  DPS  include  high  initial  capital  investment,  high  fuel  costs 
(over  anchoring),  high  maintenance  due  to  the  continuous  activation  of  thrusters,  and 
increased  manpower  requirements  for  maintenance. 

Dynamic  positioning  is  an  efiective  means  of  stationkeeping  when  water  depth  is  too 
great  for  anchoring,  on-station  time  will  be  brief,  the  vessel  is  required  to  be  on  station 
in  all  weather  conditions,  and  accuracy  in  positioning  is  more  important  than  cost. 

C.  EQUIPMENT  FOR  DYNAMIC  POSITIONING  SYSTEMS 

The  equipment  needed  for  a  dynamic  positioning  system  includes  a  wind  sensor 
(velocity  and  direction),  gyrocompass,  and  a  position  reference  sensor. 


There  are  several  position  sen,sors  that  are  employed  in  DPS  designs.  They  include 
sensors  that  determine  position,  velocity  and/or  acceleration  in  some  common  reference 
system.  The  basic  position  sensor  types  are  taut  wire,  optical,  acoustic  beacon,  and  ra- 
dio systems. 

The  taut  wire  scheme  works  by  lowering  a  weight  to  the  sea  floor  by  wire  rope.  The 
wire  is  held  in  constant  tension,  usually  by  a  constant-tension  winch,  and  any  angle  de- 
viations from  vertical  are  corrected  by  thrusters. 

Optical  positioning  systems  are  of  either  active  or  passive  design  and  make  use  of 
laser  technology.  Triangulation  of  sextant  angles  provides  position  information.  How- 
ever, sextants  are  manually  trained  by  personnel. 

Acoustic  beacon  is  the  most  common  positioning  system  in  the  offshore  industry. 
This  system  requires  a  sea  floor  beacon  and  hull-mounted  subsurface  hydrophones. 

In  general,  standard  radionavigation  systems  such  as  Loran-C,  OMEGA,  and  'fansit 
SATNAV  do  not  provide  suHicicnt  accuracy  for  DP  systems.  The  approximate  accura- 
cies of  these  systems  are; 

•  Loran-C  -  460  meters, 

•  OMEGA    -  500  meters, 

•  SATNAV   -  25  meters. 

[Ref.  l-;  p.  8-18] 

Accuracies  of  those  magnitudes  are  completely  unacceptable  for  DP  systems.  The 
NAVS'I'AR  Diflcrential  GPS,  however,  is  able  to  provide  accurate  position  information 
to  within  3  meters  an\"\vhcre  on  the  globe.  In  addition,  this  system  allows  vessels  to 
measure  velocity  using  Doppler  to  accuracies  of  about  0.1  meters  per  second.  [Rcf  I  : 
p,  8-18]. 

For  a  ship  to  be  dynamically  positioned  it  must  use  thrusters,  sensors,  computer, 
and  a  control  and  display  system.  The  thrusters  must  be  able  to  provide  fore  and  aft, 
athwartships.  and  moment  control.  Sensors  provide  physical  information  including  po- 
sition, heading,  and  wind  conditions.  The  computer  uses  sensor  information  and  calcu- 
lates required  thruster  commands  that  will  position  the  vessel  at  the  reference  position 
and  heading.  Controls  and  displays  are  required  to  allow  the  operator  to  monitor  and 
control  the  DP  system. 

1  he  purpose  of  this  thesis  is  to  design  and  simulate  a  dynamic  positioning  system 
for  a  U.S.  Coast  Guard  buoy  tender.    The  dynamic  positioning  system  is  designed  to  be 


fully  auioniaied.  perfoniiing  its  functions  in  vaning  sea  stales,  wind,  and  current  con- 
ditions uith  its  only  operator  input  benig  the  referenced  position. 


II.     BACKGROUND 

The  U.S.  Coast  Guard  has  begun  the  acquisition  process  for  seagoing  and  coastal 
buoy  tenders  to  replace  the  aging  157  foot  WLM  class  and  the  180  foot  W1,B  class 
tenders.  See  Figure  1  for  a  comparison  of  the  old  WLB  fleet  with  its  successor  [ileC.  2: 
p. 7],  One  of  the  requirements  for  tiie  replacement  vessels  is  a  dynamic  positioning  sys- 
tem. The  dynamically  positioned  vessel  must  be  able  to  approach,  maneuver,  and 
maintain  position,  within  a  circle  of  a  10  meter  radius  over  a  fixed  point  on  the  earth, 
alongside  floating  aids  to  navigation  in  restricted  channels  of  shallow,  18  loot  deep  bays, 
estuaries,  and  rivers,  Tiie  system  is  required  to  maintain  position  in  a  30  knot  wind  of 
any  aspect  and  5  knot  current  within  10  degrees  of  ships  head  [Ref.  3  :  p.  15  |.  1  his 
DPS  design  endeavors  to  take  a  modified  existing  U.S.  Coast  Guard  (USCG)  buoy 
tender  using  a  minimum  of  additional  control  and  measuremeiU  inputs  in  order  to  reduce 
the  potential  implementation  costs.  Ihis  initial  design  is  a  180  foot  WLB  "IRIS"  class 
buoy  tender.  The  only  modifications  to  existing  vessels  are  the  installation  of  a  stern 
thrustcr  and  Global  Positioning  System  (GPS).  The  GPS  provides  real-time  positioning 
information  accurate  to  within  three  meters  an}ivhcre  on  the  globe  [Ref  1  :  p.  8-18  ]. 
The  GPS  is  a  requirement  of  the  replacement  buoy  tender  fleet.  'I  he  asailable  controls 
for  this  design  are  200  SUP  bow  and  stern  thrusters  and  i  170  SUP  single  screw  propul- 
sion. System  sensor  measurements  are  GPS,  gyrocompass,  and  wind  inputs.  1  he  mul- 
tiple mission  requirements  of  the  buoy  tender,  as  with  all  Coast  Guard  cutters,  placed 
some  constraints  on  the  DPS  design  from  the  outset.  The  buoy  tender  is  occasionally 
called  upon  to  perform  some  harbor  icebreaking  duties.  It  is  considered  an  ice-capable 
\essel.  able  to  break  up  to  one  foot  of  ice  at  three  knots  [Ref  3  :  p.  15  ].  Ice  operations 
preclude  the  use  of  subsurface  position  sensing  devices  such  as  hydrophones  and  taut 
wire  schemes.  In  order  to  clarify  the  reasoning  behind  some  of  the  system  constraints, 
a  brief  qualitative  description  of  buoy  tending  operations  follows. 

A.      BUOY  TENDING  OPERATIONS 

At  the  present  time,  buoy  tending  operations  are  at  best  an  inexact  science,  as  is  the 
case  in  many  shiphandling  routines.  The  manual  ship  positioning  techniques  of  experi- 
enced deck  oflTicers  have  been  raised  to  an  art  form.  Put  simply,  by  the  use  of  sextant 
angles  or  other  "local"  points  of  reference,  the  vessel  is  slowly  aimed  at  its  intended  po- 
sition.    As  the  distance  to  the  desired  location  decreases,  the  engines  are  slowed  or 
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Figure   1.      WLB  Comparison,   (from  Ref.  2) 


stopped  altogether.  As  the  vessel  crosses  this  desired  location,  the  buoy  is  released  in 
position  and  the  vessel  continues  on.  If,  however,  the  vessel  does  not  cross  the  desired 
buoy  position,  another  pass  must  be  made.  As  weather  conditions  deteriorate,  this 
procedure  can  rapidly  increase  on  station  time.  A  dynamically  positioned  vessel  can  be 
programmed  for  a  given  location  and  heading.    The  DP  vessel  adapts  to  environmental 


changes  and  makes  optimal  use  of  thiustcts  to  maintain  position  so  it  clearly  ha^  tlu 
advantage  over  the  hit-or-niiss  scenario  just  described. 


III.     EQUAl  IONS  OF  MOTION 


The  nuithcmatical  modeling  of  the  plant',  tiic  watcrboinc  vessel  and  its  environ- 
ment, is  divided  into  several  parts:  low  and  liigh  frequency  vessel  models,  wind  model, 
and  current  model. 

A.     COORDINATE  SYSTEM 

lor  modelling  purposes,  two  dilTerent  coordinate  systems  are  used.  I:arth-fi\ed  co- 
ordinate axes  are  used  to  integrate  the  dynamic  equations  of  motion.  A  vessel  parallel 
set  of  axc^  with  the  same  origin  as  the  earth-fixed  axes,  is  used  for  computing  the  forces 
acting  on  the  vessel.  See  Figure  2  for  the  relationship  of  these  coordinate  axes  |Rci".  4: 
p. 853].  'I  he  x  and  y  axes  represent  the  vessel  in  surge  and  sway  and  the  angle  •//  i"^  the 
ve<;sel  vaw  in  decrees  true.    Hence,  headins  angle  is  the  same  for  both  sets  of  axes. 
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Figure  2.      Coordinate  AAes 


B.      LOW  FREQUENCY  MODfL 

The  equations  of  motion  for  a  floating  vessel  in  a  seaway  are  highly  coupled  and 
non-linear.  Figure  3  is  a  block  diaqram  of  the  low  frequency  (LF)  motions  of  the  vessel 
in  surge,  sway,  and  yaw.  The  low  frequency  model  represents  the  dynamic  response  of 
the  ship  in  "calm "  water  with  wind,  current,  and  propulsive  force  disturbances.  1  he  ef- 
fect of  wave  action  is  not  considered  here  as  that  is  modeled  by  the  high  frequency  model 
below.  Ihe  coupled  non-linear  differential  equations  for  surge,  sway,  and  yaw  may  be 
expressed  as  follows: 

Xl  =  I  /'";cl"VC>  l)  "Al  +f^^x''c^L  -  dx  I  -^L  "  "c  I  (-^L  "  ^0  +^wx  +^p]  +  ^lLx  (0 

h  =  1/"V[  -  ("V  -'^'J(-^L  -  "c)CrL  -Vc)  -  d^  I  -A^  I  ^i  +M,  +M^.  +M^\  +  ;/^,/,        (3) 

where 

.r^,  Xi^  -  LF  surge  position  and  velocity 

JY-Jz.  -  LF  sway  position  and  velocity 

i//^,  i//;^  -  LF  yaw  heading  angle  and  angle  rate 

u,,  \\  -  Current  velocities  in  surge  and  sway 

^»,.  ^H>  -  ^Vind  force  in  surge  and  sway 

Fp,  Fj  -  Prop  and  thruster  forces 

A/„,  Mrs  M,  -  Wind,  thruster,  and  current  moments  in  yaw 

'/l.'  '/t>-  ^1l^  •  Zero  mean  Gaussian  White  Noise  Processes 

d,,  dy,  d^,  -  Coefficients  of  Drag 

'>L'  "^yi  '^h  -  Eflbctive  Mass  Terms 
[Ref  4  :  p.  853] 
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riciire  3.      LF  Model 


C.      VESSEL  CHARACTERISTICS 

As  previously  stated,  the  modelled  vessel  is  a  LSCG  WLB    IRIS  '  class.   1  he  vessel 
is  con'iidercd  to  have  the  Ibllouing  characteristics: 

•  Length  (Overall)  -  ISOfeei 

•  Length  (between  perpendiculars)  -  \~Ofeti 

•  Beam  -  11  feci 


•  Draft-  12  feet 

•  Displacement  -  943.5  L.Tons 

•  m^  =  71920  slugs 

,      •  niy  =   147615  slugs         ' 

•  m^  =  2.61x10' si ugf I' 

•  ^,  =   169  slug  If! 

•  d^  =  869  sluglft 

•  d^  =   \Mx\0'  slugfiirad" 

[Ref.  3  :  p.  17] 

The  cfTcctive  mass  {m^,  ni^,  n\,)  terms  are  generated  by  a  computer  simulation  known 
as  the  Standard  Ship  Motion  Program  (SMP).  This  program  was  developed  at  the 
David  W.  Taylor  Naval  Ship  Research  and  Development  Center.  The  SMP  provides 
predictions  of  vessel  motion  in  translation  (surge  and  sway)  and  heading  (yaw)  in  irreg- 
ular seas  based  upon  strip  theory.  The  eOcctive  mass  is  the  sum  of  the  vessel  mass  (the 
mass  of  water  displaced  by  the  vessel)  and  an  "added  mass"  term.  The  added  mass  term 
is  predicted  by  the  S.VIP  versus  varying  frequencies  of  wave  encounter,  o.  Appendix  A 
is  the  printout  of  the  SMP  for  the  180  foot  WLB  buoy  tender.  'I  he  added  mass  and  drag 
terms  ^lown  there  are  non-dimensional.  These  terms  are  a  function  of  the  frequency 
of  encounter  of  wave  motion,  a,  which  is  also  non-dimensional.  For  purposes  of  this 
thesis,  constant  dimensionalized  values  of  drag  and  mass  are  used,  based  upon  an  "av- 
erage" wave  frequency  of  1.1  radians  per  second  which  corresponds  to  Sea  State  5  and 
an  average  wave  height  of  5.0/r  However,  the  drag  terms  of  the  SMP  cannot  be  di- 
rectly related  to  the  LF  equations  of  motion  used  here.  The  drag  coefficients  are  derived 
directly  from  Bernoulli's  equations  for  fluid  flow  on  a  moving  object: 

F=ll2pV'  (4) 

where  p  is  the  fluid  density  and  U  is  the  velocity  of  the  fluid  relative  to  the  object.  1  he 
drag  terms  are  the  product  of  the  Bernoulli  force  terms  with  the  effective  underwater 
area  of  the  vessel.  By  using  the  length  between  perpendiculars,  beam,  draft,  and  a  block 
coefficient  of  0.437,  the  drag  terms  are  as  listed  above.  Simulations  using  the  lODE 
software  package  confirm  these  values.  See  Appendix  B  for  the  simulation  results.  'I  he 
vessel  is  simulated  at  zero  sea  state  with  maximum  thrust.     Using  the  effective  mass 


teniis  ofSMP.  the  drag  coeflicicnts  are  then  varied  until  the  known  maximum  velocities 
arc  obiaincJ. 

D.  HIGH  FREQUENCY  MODEL 

The  high  frequency  vessel  model  represents  the  high  frequency  wave  action  of  the 
vessel.    Three  harmonic  oscillators  are  modelled  in  surge,  sway,  and  yaw  with  variable 

frequency,  as  follows: 

-^h  =  -    '.^^/i  -  iKx  (5) 

j  „  =  -  tol}„  +  nm  (^) 

Vh  =  -  tVV«-  ^  nov  ' ~' 

c.^  =  i;^,  (SI 

where 

•  Xf,,  Xg-  H  F  surge  position  and  velocity 

•  y'B'ymr  '"^  svvay  position  and  velocity 

•  ^B,i^„-\\¥  yaw  angle  and  angle  rate 

•  ui,,  w^  w,  -  IIF  angular  frequencies  in  surge,  sway,  and  yaiv 

•  '/..-  »/..•  »J,,-  '/p.-  »/•?,-  f  =r  -  Zero  mean  Gaussian  White  Noise  Processes 
|Rcf  4  :  p.S5?; 

E.  WIND  MODEL 

llie  wind  i?  modelled  as  the  sum  cf  slowly  varying,  low  mean  frequency  and  rapidly 
varving  high  frequency  gusts,  both  in  wind  speed  and  direction.  The  equations  for  the 
wind  model  are: 


\v^f=a2W^f+t1^df  (14) 

where  the  model  terms  are  defined  as  follows: 

vv„  -  Slowly  varying  wind  velocity 
u;^  -  Rapidly  varying  wind  velocity 
vv^  -  Slowly  varying  wind  direction 
vVrf^  -  Rapidly  varying  wind  direction 

?/^„- '/»./.  ^L.ds-  V,.d/  -  Zero  mean  Gaussian  White  Noise  Processes 
The  wind  force  terms  of  equations  1,  2,  and  3  are  then  defined  by: 

f-,^=F,(/?)(uv,  +  vv/  (15) 

/^.,  =  /^2(/?)(vVv.+Hv/  (16) 

A/H-  =  /^3(/^)(^^V5+vvy)'  (17) 

^  =  h'^5  +  »'#-('/^l+^h)  (18) 

where 

•  ^H-..  Kv>  ^L  -  Wind  forces  and  moment 

•  /?  -  Wind  angle  of  attack 

•  fi,  fj,  ^3  -  Effective  wind  surface  areas 

(Ref  4  :  p.  854] 

The  F,  terms  are  again  derived  from  Bernoulli's  equations  for  fluid  fiow.   In  this  case 
the  fluid  is  air  and  the  area  is  the  effective  area  of  wind  resistance  of  the  vessel. 

F.      CURRENT  MODEL 

The  current  model  is  described  by  the  following  set  of  differential  equations: 

^CE  =  nxCE  (19) 

ycE  =  nyCE  (20) 


'l'CE  =  n^CE  (21) 

"c  =  -^C£  COS  lA  +  ycE  sin  lA  (22) 

V,  =  -XcE  sin  lA  +  jc£  cos  lA  (23) 

with  the  terms  defined  as  follows: 

•  ■'^cE-ycE  ■  Current  velocities  in  earth  coordinates  (North  and  East  respectively) 

•  //,.  \\  -  Current  velocities  in  surge  and  sway 

[Ref.  4  :  p.  S54] 

1  hese  wind,  current,  high  frequency,  and  low  frequency  models  constitute  the  vessel 
"plant".  Each  model  represents  a  different  aspect  of  the  plant  dynamics.  It  is  clear, 
however,  that  the  only  model  which  may  be  controlled  by  the  DP  system  is  the  low  fre- 
quency model. 


IV.     CONTROL  SYSTEM  DESIGN 

A.      PROPULSORS 

The  design  of  the  buoy  tender  control  system  is  based  on  several  constraints.  First, 
there  are  only  three  propulsive  forces  available:  the  propeller  for  thrust  forward  and 
astern  (±  x  direction,  surge)  and  the  bow  and  stern  thrusters  for  moment  control 
(±  i/'direction,  yaw)  and  athwartships  motion  (±  y  direction,  sway). 

The  bow  and  stern  thrusters  are  200  HP  fixed  tunnel  units.  A  good  rule  of  thumb 
for  the  thrust  developed  by  fixed  azimuth  tunnel  thrusters  is  30  fi  Ih/jSIIP.  These  will 
yield  approximately  6000  pounds  force  in  the  ±  y  direction.  The  bow  thruster  is  located 
78.88  feet  forward  of  the  center  of  buoyancy  and  the  stern  thruster  is  81.12  feet  astern 
of  it.    See  Figure  4  for  the  thruster  layout. 

The  force  and  moment  equations  for  the  bow  and  stern  thrusters  are  thus: 

FT=BT+ST  (24) 

yUr=  78.8857- 81. 12Sr  (25) 

where  ^ 

•  FT  -  Athwartships  force  due  to  thrusters 

•  MT  -  Yaw  moment  due  to  thrusters 

•  BT  -  Force  of  bow  thruster 

•  ST  -  Force  of  stern  thruster 

It  must  be  noted  that  athwartships  force,  FT,  is  assumed  to  be  applied  at  a  single  point, 
the  center  of  buoyancy.  The  moment  force,  MT,  is  apphed  about  the  center  of 
buoyancy  by  the  thrusters  proportional  to  their  output  and  the  length  of  the  moment 
arm.  This  length  is  measured  from  the  center  of  buoyancy  to  the  thruster.  A  positive 
moment  is  considered  to  be  one  which  will  make  the  ship  turn  to  starboard,  a  negative 
moment  to  port.    See  Figure  4  for  the  thruster  moment  dimensions. 

The  fixed  pitch  propeller  is  driven  by  a  single  1170  SHP  diesel  electric  power  plant. 
It  can  normally  produce  upwards  of  20,000  pounds  force  of  thrust.  The  equation  for  the 
maximum  thrust  generated  by  the  propeller  is: 
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Figure  4.       Thruster  Forces  and  Moments 
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(26) 


Assume  a  propeller  efliciency,  ;/^,^^  =  .75  and  a  maximum  velocity,  r„,„  =  14.3  knots  .  this 
>ields    a    maximum    thrust    FP^^,=  20,250 fi  Ibf.      However,    due    to    the    natuie    of 


positionkeepiiig.  the  propeller  controller  was  limited  to  12,000  pounds  ibrte  in  the  DP 
mode. 

The  controller  design  is  based  only  on  the  low  frequency  vessel  model.  Responding 
to  the  high  frequency  wave  action  of  the  vessel  would  cause  the  controllers  to  modulate 
in  e\en  moderate  seas. 

The  low  frequency  system  was  placed  in  stale  variable  format, 


.r  =  Ax  +  Bu  +  Gw 
y  =  C.v  +  Du  +  V 
1  he  non-linear,  coupled  A  and  B  matrices  arc: 
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0 
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()  -d^  I  .V  -  U^  1  //?!,  0 

<J  0  (J  1 

0  -mjlm^  0         -dy\y-v,\ln,^. 
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1  he  state  observations  matrix,  C  is: 


10  0  0  0  0 
0  0  10  0  0 
0     0     0     0     10 


'Ihe  low  frequency  plant  is  linearized  about 

u^  =  v'^  =  (//  =  .Y  =  y  =  i) 
and  the  vessel  parameters  substituted  to  yield  the  linear  A,  B,  and  G  matrices. 
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The  plant  noise  matrix  is: 


0 

.0005 

0 
.0005 

0 
.0005 


(35) 


Ihe  state  variable  matrix  is: 


(36) 


The  control  matrix  is: 


(37) 


The  Control  Toolbox  of  the  software  package  PC-MATLAB  (for  MS-DOS  Per- 
sonal Computers,  Version  3.2-PC  June  8,  1987)  is  then  used  to  obtain  the  feedback 
gains.  Assuming  full  state  feedback  is  available,  the  Iqr  (linear  quadratic  regulator) 
function  calculates  the  optimal  feedback  gain  matrix  AT,^,  such  that  the  feedback  law: 


-^opt^ 


(38) 


minimizes  the  cost  function: 


y=  \{.x'^Qx  +  u'^Ru)dt 


(39) 


where  the  state  weighting  matrix,  Q  is: 


Q- 


B)A 

0 

0 

0 

0 

0 

0 

3  £04 

0 

0 

0 

0 

0 

0 

6£04 

0 

0 

0 

0 

0 

0 

6£05 

0 

0 

0 

0 

0 

0 

1£09 

0 

0 

0 

0 

0 

0 

1£09 

(40) 


and  the  control  weighting  matrix,  R  is: 


R  = 


'\ 

0 

o' 

0 

1 

0 

_0 

0 

1 

(41) 


The  Iqr  function  returns  the  following  feedback  gains: 


f^crt  = 


173  4977   0    0     0      0 
0    0   150  4434   24962   249962 
'0    0   193  5701  -19415  -1941: 


(42) 


This  places  the  eigenvalues  of  the  closed  loop  hnearized  system  at: 

-0.035  ±70.035' 

-0.034  ±y0.034 

-1.0 

-3.6£06 


(43) 


Since  all  the  states  are  not  available  for  feedback,  an  observer  is  utilized  to  provide 
an  estimate  of  the  states.  A  Kalman  filter  is  designed  with  the  aid  of  the  PC-MAI  LAB 
function  Iqe  (linear  quadratic  estimator).    Recall  the  system: 


and 


x  =  Ax  +  Bu  +  Gvv 


:  Cx  +  Du+\ 


(44) 


(45) 


where  the  expected  values  of  the  plant  noise,  w.  and  the  measurement  noise,  v.  are 
£Iu-]  =  £[;•]  =  0  and  the  covariance  matrices  for  plant  and  measurenient  noise  arc,  re- 
spectively, £[]vv.r']  and  £[rv'].    'fhe  covariance  matrices  are: 


£[uu']=  0.0005 


Elvv'l- 


100       0  0 

0       100        0 
0         0       .0003 


(46) 


(47) 


The  Iqe  function  returns  the  Kalman  filter  gains,  K,  for  the  equation: 


x  =  Ax  +  Bu+  Kh-  -  Cx) 
where  x  is  an  estimate  of  x.    The  Kalman  gain  matrix,  K,  is: 


(48) 
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0.0022 
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1.6069 
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0 

1.2910 

(49) 


The  output  of  the  Kalman  filter  is  the  sum  of  the  nonlinear  low  frequency  system,  in- 
cluding sampled  values  of  position,  heading,  and  wind  velocity  and  direction,  with  the 
Kalman  updates  of  position.  The  sampled  wind  velocity  and  direction  data  is  trans- 
formed into  ship's  coordinates  and  forces  the  vessel  Kalman  filter  exactly,  within  sam- 
pling error,  as  the  true  wind  forces  the  low  frequency  model.  '1  he  optimal  feedback  gains 
are  then  used  with  the  Kalman  filter  output  to  create  the  optimal  Kalman  filtered 
control; 


u  =  K^p,e 
The  reference  error  matrix,  e,  is  defined  by: 


(50) 
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The  r  values  here  represent  the  reference  positions,  heading,  and  associated  velocities. 
The  reference  positions  and  heading  are  the  desired  location  of  the  vessel.  Since  the 
desired  location  is  to  be  maintained,  clearly  the  reference  velocities  must  be  zero. 

These  optimal  controls  are  then  passed  to  a  non-Unear  filter.  1  his  non-linearity  is 
a  limiter  which  prevents  the  thrusters  and  main  propulsion  from  exceeding  the  maximum 
DP  mode  hmits  (i.e.,  12,000  /6/for  main  propulsion  and  6,000  /ft/for  thrusters  ). 

It  is  readily  apparent  that  the  control  system  as  designed  does  not  correct  for  the 
steady  state  error  caused  by  the  introduction  of  current.  A  modification  to  the  control 
design  to  compensate  for  current  ofiset  is  imperative.     A  Kalman  filter  predictor  of 


current  is  designed  based  upon  the  residual  error  in  the  vessel  position  estimator.  Tiiat 
is,  the  diflcrence  in  estimated  and  measured  position  and  heading  is  assumed  to  be  due 
to  current.  This  is  the  "measured"  value  of  the  Kalman  current  filter.  Recall  the  Kalman 
filter  equation: 


X  =  Ax  +  Du+  A'Cv  -  Cx) 


(52) 


For  the  current  predictor  filter: 


(53) 
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0  0     0  0     0  0 


(55) 


10  0  0  0  0 
0  0  10  0  0 
0     0     0    0     10 


(56) 


The  current  estimator  covariance  piatrices  arc: 

£-[;vuw' J,  =  0.00002 


fCvv'],= 


The  current  estimation  filter  gain  matrix,  A'„  is: 
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(57) 
(58) 


(59) 


The  terms  jc-j-.^Vj,  and  i/'r  are  the  observations  of  surge,  sway,  and  yaw  including  high 
frequency  wave  action  and  measurement  noise.  The  estimates  of  current  are  converted 
to  force  terms  by  Bernoulli's  equation  and  subtracted  from  the  appropriate  thrustcr 
control  commands.  Figure  5  shows  the  final  system  control  design  in  block  diagram 
form.  * 


1 

'  ■      T          K. 

... 

T 

• JL^ 

-T               —r-^ 

^  .     ^ 

Fiz  :rc   5.       Cnnt!-:'!  S^^tenl  De>izn 


V.     COMPUTER  SIMULATION 

The  equations  of  motion  and  control  system  discussed  in  previous  chapters  were 
implemented  using  the  Dynamic  Simulation  Language/VS  (DSL).  It  is  a  high  level 
continuous  simulation  language  developed  by  IBM  which  incorporates  VS  FORTIly\N 
as  a  subset.  The  program  is  included  in  Appendix  C  here  as  an  immediate  reference. 
Comments  are  included  as  additional  documentation.  DSL  was  used  here  since  it  is  a 
high  level  language  which  models  the  system  in  continuous  time.  Although  the  system 
is  modeled  as  an  analog  system,  DSL  allows  for  the  sampling  of  data  as  a\c11.  This 
sampling  was  used  with  the  position,  heading,  and  wind  measurements,  which  were  up- 
dated at  1  second  intervals.  Nearly  all  of  the  various  models  require  Gaussian  noi^c  in- 
puts wliich  are  represented  by  the  NORMAL  function.  This  function  has  inputs  of  seed 
number,  mean,  and  standard  deviation.  One  final  word  on  DSL  is  that  it  has  its  own 
plotting  routine.  System  outputs  presented  here  were  printed  using  this  plotting 
package. 


VI.     RESULTS 

The  simulation  results  oF  the  dynamically  positioned  buoy  tender  are  shown  here  in 
a  number  of  difTerent  environments.  As  discussed  previously,  the  specifications  for  the 
desired  dynamic  positioning  system  are  ambitious.  To  review,  the  vessel  is  to  attain  and 
maintain  position  to  within  a  10  meter  radius  in  30  knots  of  wind  in  any  aspect  and  5 
knots  of  current  within  10  degrees  of  the  bow.  The  initial  test  of  the  simulation  is  with 
no  current,  no  wind,  and  at  sea  state  0.  These  conditions  introduce  the  least  amount 
of  disturbance  into  the  system.  As  can  be  seen  from  Figure  6,  the  vessel  holds  position 
in  surge  to  within  5  feet.  Similarly.  Figure  7  and  Figure  8  show  the  vessel  holding  sway 
position  to  within  5  feet  and  a  decaying  exponential  response  in  yaw  angle,  with  its 
maximum  overshoot  of  0.05  radians.  In  each  graphical  presentation  of  vessel  position 
and  heading,  the  true-measured  position  and  heading  are  plotted  along  with  the  respec- 
tive vessel  Kalman  filter  estimates.  A  position  plot  is  shown  in  Figure  9.  The  position 
plot  is  presented  as  an  "overhead'  look  at  the  vessel  track  in  vessel  coordinates,  in  order 
to  obtain  this  vessel  response,  a  conservative  use  of  propulsive  force  is  used,  as  witnessed 
in  Figure   10  and  Figure   11. 

The  system  is  again  simulated  at  sea  state  0  with  no  wind  and  a  current  of  3  feet  per 
second."  in  Figure  12  the  system  performance  is  observed  in  the  surge  direction.  Since 
the  vessel  estimator  is  not  forced  by  the  current  estimator,  there  is  a  bias  introduced  by 
the  vessel  estimator,  'fhis  bias  could  he  corrected  by  modifying  the  state  variable  matrix 
with  the  current  velocities  in  surge  and  sway  such  that: 


(60) 
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This  bias  is  exactly  balanced  in  the  propulsion  scheme  by  the  current  estimated  force. 
Similarly,  the  system  performance  in  sway.  Figure  13,  and  yaw,  Figure  14,  is  within  the 
system  constraints  in  the  presence  of  this  current,    The  position  plot,  Figure  15,  closely 


resembles  its  counterpart  for  the  zero  current  case.  However,  the  overshoot  in  both 
surge  ;nul  sway  is  even  more  apparent  in  this  plot.  The  transient  performance  is  not  of 
particular  importance  as  the  steady  state  perlbrmance  is  acceptable.  Due  to  the  con- 
tinuing nature  of  the  current  disturbance,  non-zero  propulsive  forces  result  in  the  steady 
state  as  seen  in  figure  16  for  main  propulsion  force  and  in  Figure  17  for  bow  and  stern 
thrustcr  forces. 

'Ihc  vessel  when  simulated  at  a  current  velocity  of  4  feet  per  second  does  not  main- 
tain its  desired  position  due  to  the  steady  state  saturation  of  the  bow  and  stern  thrustcrs. 
The  maximum  current  for  which  this  system  is  effective  is  considered  to  be  3  feet  per 
sccontl. 

Since  fully  developed  seas  are  correlated  with  wind  velocity,  the  final  simulation  is 
at  sea  state  5  uith  current  of  3  feet  per  second  and  30  knot  winds.  With  the  addition 
of  the  Kalman  predictor  for  current  and  the  fact  that  wind  is  sampled  each  second  and 
is  incorporated  into  the  vessel  position  Kalman  liltcr,  no  great  degradation  in  sy<;iem 
performance  is  anticipated,  'fiie  surge,  sway,  and  yaw  performance  of  the  vessel  can  be 
seen  in  Figure  IS,  Figure  19,  and  figure  20,  respectively.  Ihc  vessel  response  in  surge 
and  sway  are  well  within  the  specifications.  Although  thers  is  no  requirement  to  main- 
tain Nc^scl  heading,  the  steady  state  yaw  re';ponse  of  the  vessel  is  held  to  about  0.2  radian 
of  the  reference.  The  load  on  the  propulsors  under  these  conditions  is  heavy  as  can  be 
seen  in  Figure  21  and  Figure  22.  1  he  position  plot  of  the  vessel  under  these  conditions 
is  seen  in  Figure  23.    1  he  steady  state  position  is  still  within  the  vessel  specifications. 

Although  there  is  a  degradation  in  system  performance  with  increased  environ- 
mental disturbances,  the  vessel  is  able  to  maintain  a  desired  position  to  within  the  con- 
straints imposed  at  the  outset. 
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Figure  6.      Response  in  Surge:     Sea  state  0,  No  current,  No  wind.   XT  is  measured 
surge  position  and  XE  is  estimated  surge  position. 
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Figure  7.      Response  in  S»ay:     Sea  state  0,  No  current,  No  wind.    Y  T  is  measured 
sway  position  and  YE  is  estimated  sway  position. 


Figure  8.       Response  in  \'an:     Sea  slate  0,  No  current,  No  wind.    PT  is  measured 
yaw  angle  and  PE  is  estimated  yaw  angle. 
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Figure  9.      Position  Plot:     Sea  state  0,  No  wind,  No  current 
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Figure   lU.      Main  Propulsion  Force:     Sea  state  0,  No  wind,  No  currcir 
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Figure   11.      Do>>  and  Stern  Thruster  Forces:     Sea  state  0,  No  wind,  No  current. 
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Figure   13.       SA>ay  Response:     Sea  state  0,  No  wind,  Current    =    3  fps.     YT  is 
measured  sway  position  and  YE  is  estimated  sway  position 
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Figure   14.       \a\\  Response:     Sea  slate  0,  No  wind,  Current  =  3  fps.    PT  is  meas- 
ured yaw  angle  and  PE  is  estimated  yaw  angle. 
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Figure   15.      Position  Plot:     Sea  state  0,  No  wind,  Current  =  3  fps 
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Figure   16.      Main  Piopulsioii  Force:     Sea  state  0,  No  wind,  Current  ^  3  ips 


Figure   17.      Bo>>  and  Stern  Thrustcr  Forces  :     Sea  state  0,  No  wind.  Current  =  3 
fps 


Figure   18.       Surge  Response:     Sea  state  5,  Wind  =    30  knots,  Current   =    3  f'ps. 
XT  is  measured  surge  position  and  XE  is  estimated  surge  position. 
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Figure   19.      Snay  Response:     Sea  state  5,  Wind  =  30  knots,  Current  =  3  fps.   \Y 
is  measured  sway  position  and  YE  is  estimated  sway  position. 
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Figure  20.       \'a\\  Response:     Sea  state  5,  Wind  =   30  knots,  Current  =  3  fps.    PT 
is  measured  yaw  angle  and  PE  is  estimated  yaw  angle. 
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Figure  21.      Main  I'ropulsion  Force:     Sea  state  5,  Wind  =   30  knots,  Current 
fps 
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Figure  11.      B()\\  and  Stein  Tliiuster  Forces:     Sea  state  5,  Wind  =  3U  knots,  Cui 
rent  =  3  (ps 
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F igme  23.      Position  Plot:     Sea  state  5,  Wind  =  30  knots,  Current  =  3  Ips 


MI.     CONCLUSIONS 

This  computer-based  dynamic  positioning  system  is  a  viable  alternative  to  manual 
position  keeping  methods  in  environmental  conditions  of  up  to  sea  state  5.  current  tip 
to  1.5  knots,  and  wind  up  to  30  knots,  particularly  when  precision  requirements  are 
deemed  to  be  of  greater  importance  than  fuel  cost.  In  order  to  meet  the  requirmcnt«;  for 
the  new  buoy  tender  lleet.  bow  and  stern  thrusters  of 'J 00  Sill*  should  be  installed. 
These  will  allow  the  DP  system  to  maintain  vessel  position  and  heading  in  the  eiuiron- 
mcnts  specified.  In  addition,  variable  azimuth  tlirusters  will  provide  enhanced  control 
system  perlormance  o\er  lixed  tunnel  thrusters. 


APPENUIX  A.     STANDARD  SHIP  I\I01  ION  PROGRAM 

'I  he  added  mass  and  drag  coellkients  for  the  ISO  foot  ^^■LB  "IRIS"  class  buoy 
tcndei'  arc  dunciisionalized  Jorms  of  the  \alues  presented  here. 


riguie  24.      SSMP  ^■essel  Particulars 


Figure  25.      SSMP  Added  Mass  and  Damping  Coefficients 


APPENDIX  B.     lODE  SIMULATIONS 

The  followiiig  are  printouts  froni  IODI£  programs.  lODIZ  (Interactive  Ordinary 
Dillercntial  L-quations)  is  an  interactive  software  package  that  runs  on  the  VMCMS 
nianiframc.  lODI:  interrogates  the  user  about  the  system  of  diilbrential  eciuations  and 
pro\ides  the  solution  in  tabular  and,  or  graphical  form. 

The  first  program  of  this  appendix  is  a  model  of  the  low  iVequency  vessel  in  surge, 
'fhe  vessel  is  modeled  at  full  propulsive  force,  with  no  environmental  disturbances.  Us- 
ing the  SMP  value  for  vessel  elfcctive  mass  and  the  derived  value  for  the  drag  cocllkicnt. 
the  '.  c^scl  is  simulated  in  the  open  loop  configuration  and  velocity  plotted  against  time 
in  rigurc  20  on  page  5U   The  lODE  program  listing  is: 

VARIABLES  &  INITIAL  CONDITIONS: 
X  =  .  0 
XD  =  .  0 
T  =  .  0 

CONSTANTS: 

MX  =  71920. 00000 

NX  =  .  0 

DX  =  169. 0000000 

FWX  =  . 0 

UC  =  .  0 

U  =  20250. 00000 

SPECIAL  FUNCTIONS: 
CC  =  XD-UC 

DERIVATIVES: 
D(X  /D(T  )  =  = 

XD 
D(XD  /D(T  )  =  = 

NX+(  U+FWX-DX^>ABS(  CC  )''^CC )  /MX 

OUTPUTS: 

TITLE:  SURGE  NO  FEEDBACK 
NO  TABULATION 
PLOT:  X       XD 

AGAINST:  T 
PLOT:  XD 

AGAINST:  T      AT  INTERVAL    . 2000000000 
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Figiiie  26.       Surge  .Motion  witli  No  Feedback 


As  in  the  first  simulation,  tlip  low  fiequcncy  sway  of  tlic  vessel  is  modeled  in  the 
open  loop  and  velocity  plotted  against  time  in  Figure  27  on  page  51.  The  lODI:  pro- 
gram for  sway  is: 

VARIABLES  &   INITIAL  COl^DITIONS: 
Y  =   .0 
YD  =   .  0 
T  =   .  0 

CONSTANTS: 

MY  =  147615.0000 

DY  =  869.0000000 

FWY  =  .0 

VC  =  .0 

FT  =  12000. 00000 

NY  =  .0 

SPECIAL  FUNCTIONS: 
CC  =  YD-VC 

DERIVATIVES: 
D(Y  /D(T  )  =  = 

YD 
D(YD  /D(T  )  =  = 

NY+((FT+FWY-DY'^ABS(CC)'VCC)/MY) 

OUTPUTS: 

TITLE:  SWAY  NO  FEEDBACK 
NO  TABULATION 
PLOT:  YD 

^AGAINST:  T      AT  INTERVAL    . 2000000000 

END  CALCULATION  WHEN  T  . GE.  150. 000 


Figure  27.      Sway  Motion  Auth  No  Feedback 


Finally,  the  yaw  motion  of  the  low  IVcqucncy  model  is  simulated  in  the  open  loop 
mode  and  heading  angle  rate  plotted  against  time  in  Figure  28. 


VARIABLES  &  INITIAL  CONDITIONS: 
P  =  .  0 
PD  =  .  0 
T  =  .  0 

CONSTANTS: 

MP  =  267000000.  0 

DP  =  1170000000. 

NP  =  .  0 

MW  =  .0 

MC  =  .  0 

MT  =  954000. 0000 

DUM  =  . 0 

DERIVATIVES: 
D(P  /D(T  )  =  = 

PD 
D(PD  /D(T  )  =  = 

NP+(MT+MW+NC-DP-'--ABS(PD)-"-PD)/MP 

OUTPUTS: 

TITLE:  PS  I  DOT 
NO  TABULATION 
PLOT:  PD 

AGAINST:  T      AT  INTERVAL 

END  CALCULATION  WHEN  T  .  GE.  150. 000 


Figiiie  28.       ^  a\\  Motion  with  No  Feedback 
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APrENDIX  C.     PROGRAM  LISTING 

The  (bllowiiig  is  a  listing  of  the  DSL  program  which  simulates  the  vessel,  its  envi- 
ronment, and  tlie  dynamic  positioning  control  system.  Comments  are  included 
throughout  to  augment  the  explanations  provided  in  the  body  of  the  thesis. 

^••-DEVELOPED  BY  W.  R.    CAIRNS,    LCDR,    USCG  FOR  THESIS   RESEARCH: 

^•-"DESIGN   AND   SIMULATION   OF  A   DYNAMIC   POSITIONING   SYSTEM  FOR  A   U.S. 

^'•-COAST  GUARD   BUOY  TENDER" 

TITLE:     DPSIM5 

^••THIS   PROGRAM   SIMULATES   A  WLB   "IRIS"   CLASS   USCG   BUOY  TENDER  SUBJECT  TO 

'••-WIND,    CURRENT,    AND  WAVE   FORCES   AND   CONTROLLED   BY  A   DYNAMIC   POSITIONING 

^•-SYSTEM 

•■-THE  PROGRAM  PARAMETERS  (PARAM)  ARE  DEFINED  AS: 

■■'   F1,F2,F3  ARE  THE  VESSEL  EFFECTIVE  WIND  AREAS  IN  SURGE, SWAY,  AND  YAW 

'■'   A1,A2  ARE  THE  VESSEL  WIND  VELOCITY  AND  DIRECTION  FORCE  COEFFICIENTS 

'■'   RX,RY,RP  ARE  THE  REFERENCE  POSITIONS  IN  SURGE, SWAY  AND  YAW 

PARAM  Fl  =  2. 294,F2=11.  16,F3=474. 3,.  .  . 

A1=0.  001,A2=0.  001,.  .  . 

W=00.  8,.  .  . 

IWVS=30.  0,.  .  . 

IWDS=0.  0,.  .  . 

XCI=0.  0,. 

YCI=0.  0,. 

PCI=0.  0,. 

RX=]00.  0,. 

RY=100.  0, 

RP=1.  00 
'■-THE  CONSTANTS  (CONST)  ARE  DEFINED: 

■>'   X0,XD0  INITIAL  CONDITIONS  FOR  SURGE  VELOCITY  AND  ACCELERATION 
•■'   Y0,YD0  INITIAL  CONDITIONS  FOR  SWAY  VELOCITY  AND  ACCELERATION 
-••f  P0,PD0  INITIAL  CONDITIONS  FOR  YAW  VELOCITY  AND  ACCELERATION 
■^'   MX,DX  MASS  AND  DRAG  COEFFICIENTS  IN  SURGE 
-■■•-  MY,DY  MASS  AND  DRAG  COEFFICIENTS  IN  SWAY 
•■'   MP, DP  MASS  AND  DRAG  COEFFICIENTS  IN  YAW 

'••-  NX,UX,SX  SEED, MEAN, STD  DEVIATION  FOR  LF  PLANT  NOISE  IN  SURGE 
'•'  NY,UY,SY  SEED,  MEAN,  STD  DEVIATION  FOR  LF  PLANT  NOISE  IN  SWAY 
'■'   NP,UP,SP  SEED,  MEAN,  STD  DEVIATION  FOR  LF  PLANT  NOISE  IN  YAW 
■'''   HNX,HUX,1[SX  SEED,  MEAN,  STD  DEVIATION  FOR  HF  PLANT  NOISE  IN  SURGE 
'■'   11NY,HUY,HSY  SEED , MEAN ,  STD  DEVIATION  FOR  HF  PLANT  NOISE  IN  SWAY 
'•-  HNP,HUP,HSP  SEED,  MEAN,  STD  DEVIATION  FOR  HF  PLANT  NOISE  IN  YAW 
-•■^  N\;X ,  LIWX ,  SWX  SEED,  MEAN,  STD  DEVIATION  FOR  HF  FREQ  NOISE  IN  SURGE 
'••-  NWY,UWY,SWY  SEED,  MEAN,  STD  DEVIATION  FOR  HF  FREQ  NOISE  IN  SWAY 
''•-  N\VP,UWP,SWP  SEED,  MEAN,  STD  DEVIATION  FOR  HF  FREQ  NOISE  IN  YAW 
->  MNX,UMX,SMX  SEED,  MEAN,  STD  DEVIATION  FOR  LF  NEAS  NOISE  IN  SURGE 
'■^  MNY,UMY,SMY  SEED , MEAN ,  STD  DEVIATION  FOR  LF  MEAS  NOISE  IN  SWAY 
'■'  MNP,UMP,SMP  SEED, MEAN, STD  DEVIATION  FOR  LF  MEAS  NOISE  IN  YAW 
'■^  CNX,CUX,CSX  SEED,  MEAN,  STD  DEVIATION  FOR  CURRENT  NOISE  IN  SURGE 
'■•-  CNY,CUY,CSY  SEED,  MEAN,  STD  DEVIATION  FOR  CURRENT  NOISE  IN  SWAY 
'■'   CNP,CUP,CSP  SEED, MEAN, STD  DEVIATION  FOR  CURRENT  NOISE  IN  YAW 
'■f  NCX,MCX,SCX  SEED,  MEAN,  STD  DEVIATION  FOR  CURRENT  NOISE  IN  SURGE(KALMAN) 


*  NCY,MCY,SCY  SEED, MEAN, STD  DEVIATION  FOR  CURRENT  NOISE  IN  SWAY  (KALMAN) 

*  NCP,NCP,SCP  SEED, MEAN, STD  DEVIATION  FOR  CURRENT  NOISE  IN  YAW   (KALMAN) 

*  N\A'S  ,  WVS  ,  SWVS  SEED, MEAN, SD  FOR  SLOW  WIND  VELOCITY  NOISE 

*  NWVF  ,  L^>'VF  ,  SWVF  SEED,  MEAN,  SD  FOR  FAST  WIND  VELOCITY  NOISE 

*  M>DS,UWDS,SWDS  SEED, MEAN, SD  FOR  SLOW  WIND  DIRECTION  NOISE 

*  M> DF , nVDF , SWDF  SEED, MEAN, SD  FOR  FAST  WIND  DIRECTION  NOISE 
'■'  FPR,FPL  PROPULSION  LIMITER  C+Z") 

'■'  ETR,BTL  BOW  THRUSTER  LIMITER  (+/-) 

■>'   STR,STL  STERN  THRUSTER  LIMITER  (+/-) 

■>''   EXD,EXU  DEAD  SPACE  IN  SURGE 

"  EYD.EYU  DEAD  SPACE  IN  SWAY 

'>  EPD,EPU  DEAD  SPACE  IN  YAW 

■>''   RXD,RYD,RPD  REFERENCE  VELOCITIES  IN  SURGE,  SWAY,  YAW 

'>  K  VESSEL  KAL!1AN  FILTER  GAINS  SUBSCRIPTED  ACCORDING  TO  MATRIX 

'>  C  CURRENT  ESTIMATION  FILTER  GAINS  SUBSCRIPTED  ACCORDING  TO  MATRIX 

'>  G  OPTIMAL  FEEDBACK  GAINS  SUBSCRIPTED  ACCORDING  TO  MATRIX 

CONST  XO=O.O.XDO=0.0,.  .  . 

Y0=0.  0,YDO=0.  0,.  .  . 

P0=0.  0,PDO=0.  0,.  .  . 

HX=71920. 0,DX=169. 00000,. . 

MY=147615.0,DY=869. 0000,. . 

MP=2.  67D+08 ,DP=1.  17D+09 , . . 

NX=19. 0 ,UX=0. 0 , SX=0. 0005 , . 

NY=21.0,UY=0.  0,SY=0.  0005,. 

NF=23.0,UP=0.0,SP=0.  00001, 

HNX=19. 0 ,HUX=0.  0 , HSX=3. 0 , . 

HNY=21.  0,HUY=0.  0,HSY=3.  0,. 

nNP=23. 0,HUP=0. 0,HSP=0. 175 

N-WX=19.  0,UWX=0.  0,SWX=0.  005 

MvY=21.  0,WY=0.  0,SWY=0.  005 

N^-P=23.  0,UWP=0.  0,SWP=0.  000175 

MNX=19. O.UMX=0.  0,SMX=3.  0000,. 

MNY=21.  0,UMY=0.  0,SMY=3.  0000,. 

HNP=23. 0,UMP=0. 0,SMP=0. 0175,. 

CNX=19.0,CUX=0.  0,CSX=0.  00050, 

CNY=21.  0,CUY=0.0,CSY=0.  00050, 

CNP=23. 0,CUP=0. 0,CSP=0.  00001, 

NCX=19.0,MCX=0.0,SCX=0.  0005,. 

NCY=21.  0,MCY=0.  0,SCY=0. 0005,. 

NCP=23. 0,MCP=0. 0,SCP=0. 00001, 

N'WVS=19.  0,UWVS=0.  0,SWVS=0.  0005  . 

N\AT=21.  0,L'\vTF=0.  0,SWVF=0.  0005, 

^^05=23.  0,U'WDS=0.  0,SWDS=0.  00001 

N'VDF=23.  0,U\;DF=0.  0,SWDF=0.  00001 

VNN=15.  0,VNU=0. 0,VNS=0. 0005,. . . 

FFR=12000. 0,FPL=-12000. 0,. . . 

BTR=6000.  0,BTL=-6000. O,.  . . 

STR=6000.  0,STL=-6000.  0,.  .  . 

RXD=0.0,RYD=0.0,RPD=0.0,.  .  . 

K11=0.  0669,K12=0.  0,K13=0.  0,. 

K21=0. 0022,K22=0. 0,K23=0. 0,. 

K31=0. 0,K32=0. 0669,K33=0.  0,. 

K41=0. 0,K42=0. 0022,K43=0.  0,. 

K51=0.  0,K52=0.  0,K5  3=1.  6069,. 

K61=0.  0,K62=0.  0,K63=1.  2910,. 

C11=0.  014,C12=0.  0,C13=0.  0,.  . 


C21=0.  004A,C22=0.  0,C23=0. 0, 

C31=0.  0,C32=0.  014,C33=0.  0,. 

C41=0.  0,C42=0. 0044,C43=0. 0, 

C51=0.  0,C52=0. 0,C53=6. 0000, 

C61=0.  0,C62=0. 0,C63=18. 200, 

Gll=193.  0,G12=5701.  00,G13=0.  0,G14=0.  0,G15=0.  0,G16=0.  0,.  .  . 

G21=0. 0,G22=0. 0,G23=150. 0,G24=4434.  0,G25=24962.  0,G26=24962.  0,.  .  . 

G31=0.  0,G32=0.  0,G33=193.  0,G34=5701.  0 ,G35  =  - 19415. 000 ,G36=-194 15. 00 

Gll  =  78. 50,G12=9200. 00,G13=0. 0,G14=0.  0,G15=0.  0,G16=0.  0,.  .  . 
'■^     G21=0.  0,G22=0.  0,G23=42.  00,G24=7200.  0,G25=5854.  0.G26=8200.  0 

G31=0. 0,G32=0. 0,G33=38. 0,G34=6900. 0,G35=-4553.  000 ,G36=- 7500.  00 

G11=7  7.46,G12=3335. 50,G13=0. 0,G14=0.  0,G15=0.  0,G16=0.  0,.  .  . 

G21=0. 0,G22=0. 0,G23=47. 556 ,G24=2483. 80,G25=249.  62,G26=136.  7,.  .  . 

G31=0. 0,G32=0. 0,G33=61.  14,G34=3193. 40,G35=-194.  150 ,G36=-106. 34 
DYNAMIC 
'VLOW  FREQUENCY  MODEL  PLANT  NOISE  IN  SURGE,  SWAY,  AND  YAW 

NOIX=NORMAL(NX,UX,SX) 

NOIY=NORMAL(NY,UY,SY) 

NOIP=NORMAL(NP,UP,SP) 
'•^HIGH  FREQUENCY  MODEL  PLANT  NOISE  IN  SURGE,  SWAY,  AND  YAW 

HNOIX=NORMAL( HNX , HUX , HSX) 

}1N0IY=N0RNAL(  HNY  ,  HUY  ,  HSY  ) 

HNOIP=NORMAL(HNP,J{UP,HSP) 
'•^MEASUREMENT  NOISE  IN  SURGE,  SWAY,  AND  YAW 

MNOIX=NORMAL( MNX , UMX , SMX) 

MNOI Y=NORMAL( MNY , UMY , SMY ) 

MNOI P=NORMAL( MNP , UMP , SMP) 
'•^CURRENT  NOISE  IN  SURGE,  SWAY,  AND  YAW 

CXNOI=NORMAL( CNX , CUX , CSX) 

CYNO 1=N0RMAL( CNY , CUY , CSY ) 

CPNOI=NORMAL( CNP , CUP , CSP ) 
^'^KALMAN  FILTER  CURRENT  NOISE  IN  SURGE,  SWAY,  AND  YAW 

KCX=NORMAL( NCX , MCX , SCX ) 

KCY=NORMAL( NCY , MCY , SCY) 

KCP=NORMAL(NCP,MCP,SCP) 
'•^WIND  NOISE  (SLOW/FAST  VARYING)  (VELOCITY  AND  DIRECTION) 

WVNS=NORMAL(  N^VVS  ,  UWVS  ,  SWVS ) 

WVNF=NORMAL( NWVF , UWVF , SWVF ) 

WDNS=NORMAL( NWDS , UWDS , SWDS ) 

WDNF=NORMAL( NWDF ,UWDF , SWDF) 
'"^ESTIMATOR  ERROR  -  INNOVATIONS  IN  SURGE,  SWAY,  AND  YAW 

INX=XT-XE 

INY=YT-YE 

INP=PT-PE 
'■^CURRENT  CORRECTION  (AS  APPLIED  TO  LF  VESSEL  MODEL) 

Q1=XD-UC 

Q2=YD-VC 
'''THRUSTER  FORCE  =  BOW  TJIRUSTER  +  STERN  THRUSTER 

FT=BT+ST 
^^BOW  THRUSTER  CONTROL 

BTI=  G21'>EX+G22''-EXXD4-G23'--EY+G24^>EYYD+G25''^EP+G26''^EPPD 

BTII=BTI-(DY-->(VCH)'--ABS(VCH)+FWYS) 
'^     BTII=BTI-FWYS/2.  0 

BT=LIMIT( BTL , BTR , BTI I ) 
'^STERN  THRUSTER  CONTROL 

STI=  G31---EX+G32--'^EXXD+G33"EY+G34''^EYYD+G35'>EP+G36'>EPPD 


STII=STI-(DY--KVCH)'''ABS(VCH)+FWYS) 

STII=STI-FWyS/2. 0 

ST=LIM1T(STL,STR,STII) 
^•^PROP  CONTROL 

FPI=  Gll'>EX+G12'>EXXD+G13--EY+G14''fEYYD+G15''^EP+G16->EPPD 

FPII=FPI-(DX^>UC-"-ABS(UCH)+0.  75^''FWXS) 

FPII=FPI-FWXS 

FP=LIMIT(FPL,FPR,FPII) 
^■'MOMENT  CONTROL 

MT=78.  88''-BT-81.  12^'^ST 
SAMPLE 
^■••TOTAL  VESSEL  MOTION  MODEL  -  MEASUREMENTS  IN  SURGE,  SWAY,  AND  YAW 

XT=X+XH+MNOIX 

YT=Y+YH+MNOIY 

FT=P+FH4MN0IP 
'•^SAMPLED  WIND  FORCES  AND  MOMENT  IN  SURGE,  SWAY,  AND  YAW 

FWXS=FWX 

FWYS=FWY 

M\s'S=MV,' 
DERIVATIVE 

■>n,0\s    FREQUENCY  VESSEL  MODEL 
'•^LF   SURGE 

X=INTGRL(XO.XD) 

XD=INTGRL(XDO,XDD) 

XDD=N0IX+(FWX+FP-DX'>Q1^'^ABS(  Ql  )+MY''^Q2-'--PD+MX^'--VC''^PD)  /MX 
^•■•LF   SWAY 

Y=INTGRL(YO,YD) 

YD=INTGRL(YDO,YDD) 

YDD=N0IY+(FWY+FT-DY''Q2--'^ABS(Q2)+MY'"^UC''^PD+MX-'^Ql-"-PD)/MY 
'•^F   YAW 

P=INTGRL(rO,PD) 

PD=INTGRL(PDO,PDD) 

PDD=N0IP+(-(MY-MX)'>Ql'^Q2-DP-'^ABS(FD)'"^PD+MC+MV+MT)/MP 
^'OlIGH   FREQUENCY   VESSEL  MODEL 
"}1F   SURGE 

XH=INTGRL(0.0,XHD) 

XHD=INTGRL(0.0,XHDD) 

X11DD=  -  ( WX--"'' 2 )  '"-XH+HNO I X  - .  2^'-XHD 
-HF   SWAY 

YH=INTGRL(0.0,YHD) 

YHD=INTGRL(0.0,YHDD) 

YHDD=  - ( WY^>" 2 ) ^"-YH+IINO I Y - .  2--n'HD 
'>tIF   YAW 

PH=INTGRL(0.0,PHD) 

PHD=INTGRL(0.0,PHDD) 

PHDD=-(WP^^^^2)''^PH+HN0IP-.  2'"'PI1D 
'•^IIF  WAVE  FREQUENCY  VARIATION  MODEL 
-■■'FREQUENCY    IN   SURGE 

WX=INTGRL(W.WXD) 

WXD=N0RMAL(  NWX  ,  U\v"X ,  SWX) 
'■^FREQUENCY   IN   SWAY 

WY=INTGRL(W,WYD) 

WYD=NORMAL( NWY , UWY , SWY ) 
^^FREQUENCY    IN   YAW 

WP=INTGRL(W,WPD) 


VPD=NORtIAL(  N\vT  ,  U\vT  ,  SWP) 
''^CURRENT  MODEL   IN   EARTH   COORDINATES 

XCED=INTGRL(XCI,XCEDD) 

XCEDD=CXNOI 

YCED=INTGRL(YCI,YCEDD) 

YCEDD=CYNOI 

PCED=INTGRL(PCI,FCEDD) 

PCEDD=CPNOI 
'>CURRENT  MODEL   IN   SURGE,    SWAY,    AND   YAW 

UC=XCED--'-DCOS(PT)+YCED^>DSIN(PT) 

VC=-XCED-'VDSIN(  PT)+YCED''^DCOS(  PT) 

HC=PCED 
^nVIND   MODEL 
^■^SLOWLY   VARYING   WIND   VELOCITY 

WVS=INTGRL( IWVS ,WVSD) 

WVSD=WVNS 
'VRAPIDLY   VARYING   WIND   VELOCITY 

WVF=INTGRL(0.  0,WVFD) 

WVFD=Ar-^WVF+WVNF 
^•-SLOWLY  VARYING  WIND  DIRECTION 

WDS=INTGRL( IWDS ,WDSD) 

WDSD=WDNS 
'■^RAPIDLY  VARYING  WIND  DIRECTION 

WDF=INTGRL(0.  O.WDFD) 

WDFD=A2^>WDF+WDNF 
^>WIND   ANGLE   OF   ATTACK 

BETA=WDS+WDF-PT 
^n^/IND  FORCE  EQUATIONS  IN  SURGE,  SWAY,  AND  YAW 

FWX=-Fl''--DC0S(DETA)'V(WVS+WVF)''"'--2 

FWY=-F2----DSIN(BETA)^'-(WVS+WVF)''--'-2 

m;=F3-'>DSIN(BETA)^HWVS+WVF)'">2 
''^KALMAN  FILTER  FOR  VESSEL 
^■^VESSEL  KALMAN  IN  SURGE 

EX=RX-XE 

EXXD=RXD-XED 

AXE=(-DX-->(XED-0.  )^--ABS(XED-0.  )+MY-"-(  YED-0.  )''^PED+MX^''0. '>PED)/MX 

BXE=(FP+FWXS)/MX 

XE=INTGRL(0.  O.XED) 

XED=INTGRL(0.  0  ,XEDD)+K11^'^(XT-XE)+K12'n  YT-YE)+K13-'>(  PT-PE) 

XEDD=AXE+BXE+K21--''(XT-XE)+K22^--(YT-YE)+K23'>(PT-PE) 
'•^VESSEL  KALMAN  IN  SWAY 

EY=RY-YE 

EYYD=RYD-YED 

AYE=(-DY^nYED-0.  )->ABS( YED-0.  )+MX*(XED-0.  )^--PED+MY^'^0.  ^^PED)/MY 

BYE=(FT+FWYS)/MY 

YE=INTGRL(0.  0,YED) 

YED=INTGRL(0.  0  ,  YEDD)+K31''--(XT-XE)+K32'H  YT-YE)+K33^'(  PT-PE) 

YEDD=AYE+BYE+K41^>(XT-XE)+K42'HYT-YE)+K43''-(PT-PE) 
^'VESSEL  KALMAN  IN  YAW 

EP=RP-PE 

EPPD=RPD-PED 

APE=(-(MY-MX)'HXED-0.  )'HYED-0.  ) -DP'''PED-"-ABS(  PED)  )/MP 

BPE=(MWS+MT+0.  )/MP 

PE=INTGRL(0.  0,PED) 

PED=INTGRL(0.  0  ,PEDD)+K51--'-(XT-XE)+K52-"-(  YT-YE)+K53^'^(  PT-PE) 


PEDD=APE+BPE+K61'>(XT-XE)+K62^--fYT-YE)+K63'HPT-PE) 
'"'FILTER  PREDICTION  OF  CURRENT  OFFSET 
'■'CURRENT  PREDICTION  IN  SURGE 

CX=INX-XCH 

XCH=INTGRL(0.  0,UCH) 

UCH=INTGRL(0.  0  ,UCHD)  +  (C11'''CX) 

UCHD=(C21-->INX) 
'^CURRENT  PREDICTION  IN  SWAY 

CY=INY-YCH 

YCH=INTGRL(0.  0,VCH) 

VCH=INTGRL(0.  0 ,  VCHD)+(C32-''CY) 

VCHD=(C42-'>INY) 
'■'CURRENT   PREDICTION   IN   YAW 

CP=INP-PCH 

PCH=INTGRL(0.  0,PCHD) 

FCHD=INTGRLro.  0  ,PCHDD)  +  (C53'--CP) 

PCHDD=(C63'^'CP) 
TRANSFORM  BACK  TO  VESSEL  COORDINATES 

MCH=PCHD 
CONTROL  FINTIM=800.  0,DELT=.  10,DELS=1.  0 
METHOD  RKSFX 
SAVE  10. 00,X,EX,FP,Y,EY,BT,STJIT,P,EP,XT,YT,PT,XE,YE,PE,XH,YH,PH,.  . 

FWX ,  FWY  ,  M\v ,  XDD , XHDD  ,  MC  ,  UC  ,  VC  ,  UCH ,  VCH ,  INX ,  INY ,  INP  ,  XED ,  YED  ,  PED 
'■'HINT  UC,UCH,VC,VCH 

GRAPH  (G1,DE=TEK618)  TIME(UN=' SEC' ) ,XT(UN=' FT' ) ,XE 
LABEL  (Gl)  XT  VS  TIME 

GRAPH  (G2,DE=TEK618)  TIMECUN=' SEC ' ) , YT(UN=' FT' ) , YE 
LABEL  (G2)  YT  VS  TIME 

GRAPH  (G3,DE=TEK618)  TIME(UN=' SEC' ) ,PT(UN=' RAD' ) ,PE 
LABEL  (G3)  PT  VS  TIME 

GRAPH  (G4,DE=TEK618)  TIME(UN=' SEC ' ) ,FP(UN=' LBF ' ) 
LABEL  (G4)  PROP  CONTROL 
GRAPH  (G5,DE=TEK618)  TIME. BT, ST 
LABEL  (G5)  THRUSTER  CONTROL 
GRAPH  (G6,DE=T£K618)  Y(UN=' FT' ) ,X(UN=' FT' ) 
LABEL  (G6)  POSITION  X  VS  Y 
GRAPH  (G7,DE=TEK618)  XE,XED 
LABEL  (G7)  PHASE  PLANE 
'•'GRAPH  (G7,DE=TEK618)  TIME, UC, UCH 
'•'LABEL  (G7)  POSITION  UC,UCH  VS  TIME 
'•'GRAPH  (G8,DE=TEK618)  TIME,VC,VCH 
'■'LABEL  (G8)  POSITION  VC,VCH  VS  TIME 
'■'GRAPH  (G9,DE=TEK618)  TIME,  INX,  INY 
'■'LABEL  (G9)  ERROR  RESIDUALS 
'■'GRAPH  (G8,DE=TEK618)  TIME,Y,YH 
'■'LABEL  (G8)  HIGH  AND  LOW  FREQUENCY  SWAY 
'■'GRAPH  (G9,DE=TEK618)  TIME,P,PH 
'•'LABEL  (G9)  HIGH  AND  LOW  FREQUENCY  YAW 
END 
STOP 
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